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Abstract 

This paper investigates a modification of cyclic constant bearing (CB) pursuit in 
a multi-agent system in which each agent pays attention to a neighbor and a beacon. 

The problem admits shape equilibria with collective circling about the beacon, with the 
circling radius and angular separation of agents determined by choice of parameters in 
the feedback law. Stability of circling shape equilibria is shown for a 2-agent system, 
and the results are demonstrated on a collective of mobile robots tracked by a motion 
capture system. 

Index Terms - Cyclic pursuit, Multi-agent systems, Decentralized control, Robot motion 


1 Introduction 

Previous works HH3 have demonstrated pertinence of dyadic pursuit interactions as a build¬ 
ing block for collective control. In 00, the particular focus is on a cyclic pursuit scheme in 
which each agent employs a constant bearing (CB) pursuit law [8] with regards to exactly 
one other agent in the collective. In that context, it was demonstrated (for a range of control 
parameters) that the closed-loop dynamics admit circling relative equilibria (among other 
special solutions), with the corresponding formation shape determined by the choice of con¬ 
trol parameters. However, both the location of the circumcenter (with respect to an inertial 
frame) and the radius of the circular orbit are determined by initial conditions rather than 
control parameters, which limits the effectiveness of the control methodology from a design 
perspective. 

In the current work, we introduce a modified version of the CB control law, in which the 
pursuer is attentive to both a neighboring agent as well as to a beacon (which is assumed to be 
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fixed in the current setting). Though the control law is not designed to stabilize a particular 
station-keeping range from the beacon, we demonstrate that in an u-agent collective where 
each agent i employs this “beacon-referenced” CB control law with respect to agent i + 1 and 
a common beacon, circling equilibria exist which are centered on the beacon position and 
have a radius determined by the control parameters. For the case where n = 2, we analyze 
the stability of the associated circling equilibria by linearization of the dynamics, deriving 
stability conditions in terms of the control parameters. 

While our approach is motivated by the numerous robotic station-keeping applications 
which require autonomous agents to orbit a specified location while maintaining a fixed 
formation shape and scale (e.g. search and rescue, environmental sensing, etc.), we also 
note that this work may provide insights into the mechanisms underlying collective behavior 
observed in nature. For example, the beacon-referenced cyclic pursuit analyzed in this paper 
may provide tools for modeling the “explore-exploit” behavior evidenced by some animal 
collectives (e.g. honeybees i) searching for food sources. 

2 Modeling the interaction 

2.1 Modeling the system 

As presented in jlOllllj . we model an agent as a unit-mass self-steering particle with twice- 
differentiable motion path in R 2 . This allows us to use natural Frenet frame (12] equations 
to describe the motion for a group of n agents. By letting rj denote the position of the z-th 
agent, underlying system dynamics can be expressed as 


r i 

= zyx* 



X; 

= XU-Xi 


( 1 ) 

y; 

= -ViUiXi, i = 1,2,.. 

•, n. 



Here Xj is the normalized velocity and y, ; represents orthogonally rotated x, ; in the counter¬ 
clockwise direction. Moreover, v j is the speed, and u t is the natural curvature viewed as a 
steering control. Alternatively, by packing r,; , x,;, y ?; inside a matrix 

e SE( 2), (2) 

the natural Frenet frame equations ([T]) can be expressed as a left invariant dynamics on 
SE( 2). From this perspective, the dynamics of an agent can be expressed as 

9i = 9it% = Vi9i{X Q + UiX 2 ), (3) 

where X 0 and X 2 represent standard basis elements of se( 2). 

As discussed earlier, practical applications often require the collective of agents to maneu¬ 
ver with respect to some particular desired location. Therefore, in this work we introduce a 
beacon at location r& e R 2 , along with a fixed frame [x& yj attached to it (which is assumed 
to be the inertial reference frame, without loss of generality), and define g & e SE( 2) as in 
© to pack r&, Xf, and y& inside a single matrix. 


9i - 


0 0 1 
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2.2 Directed graph and commutativity constraints 

Now we introduce the notion of an attention graph [2] to describe which agent (s) a particular 
agent is paying attention to. By letting J\f = {1,2 ,...,n,b} denote the node-set for the 
problem of our concern, the corresponding arc/edge-set (M) is defined as 

A = {(*,* + 1), (i,b)\i = 1,2,.. . ,n}, (4) 

where addition in the index variables should be interpreted modulo n throughout this paper. 
Clearly, this attention graph Q = ( J\f. A) is weakly connected and devoid of any self loop. 

Now, we formulate a reduction to the shape space, and introduce the following set of 
variables (possibly redundant) along arcs of the attention graph Q: 

9i,i +1 9i+l9i (5) 

and, g ib = g^ 1 g t . ( 6 ) 

It follows from the definition that g^i+i, i = 1,2, ...,n are subject to the cycle closure 
constraint 

n 

<7i,»+l = 9nl9n—l,n ' ’ ' 923912 = I 3 , (7) 

i= 1 

where I 3 is the 3x3 identity matrix. (See also [2].) Moreover, by exploiting the commutative 
property, we have 

9i,i +1 = 9i+i,b9ib, i = 1, 2, • • •, n - 1. ( 8 ) 

This set of equations ([S]) poses consistency conditions on the space of shape variables. We 
should note here that together (J7j) and (jSJ) ensure g n i = g^ b g n b- 

Also, from (]3]) , (JSJ) and dSJ), it follows that the shape dynamics can be expressed as 

9ib = 9ib£,i-t 

aild 9i,i +1 9i,i+l^i,i+li 

where £^+1 = 6 ; — 9u +1 &+ 1 9i,i +1 • It is a straightforward exercise to show that the constraints 
dZD-dHD w dl be satisfied for all future time if they are satisfied initially. 


2.3 Scalar shape variables 


Now, following the approach of earlier works [2J, we introduce scalar shape variables (a polar 
parametrization) to describe the state of an agent relative to the beacon and other agents. 
By letting 


R{&) 


cos d — sin $ 
sin d cos $ 


e 50(2) 


( 10 ) 


denote a counter-clockwise planar rotation through an angle ■$, we define a set of scalar 
shape variables p i} p ib , K t , K lb and ipi as 


Pi |^i+l,i| 

1 

Pib 

| I*6,i |, 


R{Ki)Xi = 

**i+l,i 

1 1 7 

Rfr) 

)x t = 

ri.i-1 

| r i+l,i| 



R(n ib )xi = 

r b,i 

1 1 7 

R( 7T ■ 

- i>i)*b 

r b,i 

\r b ,i\ 

|r 6 ,i| 


( 11 ) 
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Figure 1: Illustration of the scalar shape variables (p*, p^, Oj, and k^,) used in our analysis 
of an n-agent system with a hxed beacon at location r&. 


where i = 1,2,... ,n and r,;j = r* — represents the position of z-th agent relative to the 
j'-th agent (see Fig [I]). 

Using these recently introduced scalar shape variables, the consistency conditions flH]) can 
be expressed as 


R(A - ipi+ 1 ) = 0 i+ 1 + K i+ltb - K ib ) ( 12 ) 

Pi 12 PibR^Hib Hi) T Pi+l,6-^(^j+l,b ^i+l) (13) 

for z=l,2,...,n — 1. In a similar way, the cycle closure constraint (JTJ) can be expressed as 

n 

R(Y l (* + K i -O i+ 1)) =h (14) 

i =1 

n i 

Yi P iR ( 2 ^+ k j -^+ 0 ) = °- ( 1 5 ) 

i=l j =1 


In actuality, certain simplifications allow us to consider only a subset of these variables and 
constraints. First, it is clear that for a particular choice of i \)\, (fT2]l provides an explicit 
representation for the scalar shape variables -0*, z = 2,3,..., n in terms of other shape 
variables, and therefore we can disregard those variables as well as constraint (fl2l) from the 
following analysis. Furthermore, the choice of beacon frame [x& yj is arbitrary and the 
proposed feedback law (see Section III) is invariant to any rotation of the beacon frame, 
and therefore there exists an tS 1 symmetry enabling us to exclude tpi from further analysis. 
Finally, one can show that (fT3l) together with (TT4T) and (fT5]l can be expressed more concisely 
as simply (1131) (holding for i = 1,2,... ,n) with m Therefore, the shape space can be 
parametrized by the scalar variables Ki, Kib,&i, Pi, Pib, f° r i = 1,2, ...,rz, subject only to 
the positivity constraints on p, and p^, (necessary for the well-posedness of a feedback law 
introduced in the next section) and the constraints (fT3j) - (fT4l) for i = 1,2,..., n, i.e. 

n 

R{Y^ n + ^ ~ 0 *+i)) = ^ ( 16 ) 

i= 1 

Pi I2 PibR^Hib Hi) + Pi+l,i>-^(^i+l,& ^t+l)- (1 0 

Next we focus on representing the shape dynamics (J9]) in terms of scalar shape variables. 
By straightforward calculations, one can show that the shape dynamics are given in terms 
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of the scalar variables by 


Pi 

ki 


— Vi COS Ki — V i+ i COS 9 i+ i 

-ViUi + — \vi sin Ki + v l+ i sin 9 i+1 ] 

Pi 

-ViUi H- [vi _i sin k ^i + v.i sin 9i\ 

Pi—1 


Pib ^i COS foil) 

Vi 

K ib = -ViUi H-sill K ib , i = 1, 2,..., n, 

Pib 

subject to the cycle closure constraint (TT^l) and consistency conditions (1T7T) . 


( 18 ) 


3 A beacon-referenced CB pursuit law 


In this section we introduce a modified version of the CB pursuit law from [ 8 ] that introduces 
an additional term referenced to the beacon bearing. We construct this feedback law as a 
convex combination of two fundamental building blocks, expressed as 


Ui — (1 — X)u l CB + A u l B , A e [ 0 , 1 ] 


(19) 


where u l CB is given by the original CB pursuit law [ 8 ] referenced to agent i + 1, and u l B 
represents the deviation from a desired bearing angle to the beacon. More specifically, we 
choose 


u cb = ~h L i R ( a i) y 


i,i+l 

l r v+i I 


1 

^i\ r i,i+l 


(Sim 

\ \ r i,i+l 


R( n/2)r 


i,i +1 


( 20 ) 


with Hi > 0 being a control gain and the angle <7 e S 1 representing the desired offset between 
the z-tfi agent’s heading and the current location of the (i + l)-th agent. For the beacon 
tracking component, we let 


u b = ~Pi ( R {^ib)yi ■ 7 ^ 7 ) , ( 21 ) 

V \ r i,b\/ 

where Hi > 0 is the corresponding control gain and the angle ai b e S 1 is the desired offset 
between the current heading of the z-th agent and the bearing to the beacon location. Note 
that the neighbor tracking goal may conflict with the beacon referencing goal, and the 
parameter A maintains a balance between the beacon’s influence and the influence of the 
neighboring agent % + 1. In particular, for A = 0, Ui is simply the original CB pursuit law 
with no reference to the beacon. 

In terms of scalar shape variables, the feedback law w* can be expressed as 


Ui = A H b i sin (K ib - a ib ) + (1 - A )hi sin(^ - cp) + 


1 -A 

Pi 


. F;+i . Q 
sin Ki H-sm 9 i+ 1 


( 22 ) 


Remark 3.1. As noted in JBS, the last component of this feedback law (l22j) can be interpreted 
as the angular speed at which the baseline between agent-i and agent-i + 1 is rotating around 
the i-th agent. Therefore it is plausible to evaluate the steering command u^ without explicit 
measurement of distance between the agents, although it will require an appropriate sensing 
mechanism (mimicking the principle of compound eyes in visual insects). 
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Before going into detailed analysis of relative equilibria, we introduce the following sim¬ 
plifying assumptions: 

(Al) The speed of the agents are equal and constant. Hence, without loss of generality, we 
can assume zy = 1 for every ze{l,2,...,n}. 

(A2) The controller gains (p* and p%) are equal and common for all agents, i.e. /q = p r - = p. 
for every i e { 1 , 2 ,..., n}. 


(A3) The bearing angles (ck*) with respect to the beacon are common for all agents, i.e. 
®ib = «o for every j e { 1 , 2 ,..., n}. 

Under assumptions (Al)-(A3), the closed loop shape dynamics 1 (1151) with (J22D) can be 
expressed as 


Pi = — ( COS Ki + COS 9 i+ 1 ) 


A 


ki = — /i[(l — A) sin (Ki — ctj) + A sin — cko)] H-[sin Ki + sin^+i] 

Pi 

6i = ki -[ sin Ki + sin 9 i+1 \ H-[ sin «;*_! + sin 9A 

Pi Pi-i 

Pib COS HLib 

kib = ki -[ sin Ki + sin 9 i+ A -\ -sin 

Pi Pib 

for i = 1,2,... ,n, subject to the constraints (fT6l) - (fT7l) . 


(23) 


4 Relative equilibria 


In this section we analyze the closed loop shape dynamics (1251) to determine existence con¬ 
ditions and characterization of their equilibria (i.e. relative equilibria for the full dynamics 
([1]) with (fT9l) l. At the extreme value of A = 0, the shape dynamics simplify to the cyclic CB 
pursuit dynamics previously analyzed in [2], while at the other extreme, inter-agent interac¬ 
tion is completely lost whenever A = 1. Therefore we restrict A to lie in the open interval 
(0,1) for the rest of our analysis. 

From the form of p,b and p, in (125|) . we can obtain necessary conditions at equilibrium 
given by 



and, 9 i+ i = n ± Ki, 


(24) 


for i = 1,2,..., n. Similarly, by setting the dynamics of 9i and k^ equal to zero, we obtain 
(for i = 1, 2 ,..., n) 


— (sin/vj + sin(9j + i) = -(sin«)j_i + sin#*), (25) 

Pi Pi —1 

— (sin Ki + sin 9 i+ 1) = — sin k^. (26) 

Pi Pib 

A straightforward calculation reveals that if Kn = +tt/2 with k* = 7 r + #i+i, then (1261) results 
in a contradiction since its left hand side vanishes to zero, contrary to a non-zero (+1 /p*b) 
right hand side. Thus, at a relative equilibrium, we have 


9i +1 = 7 T - Ki, i = 1,2,... ,71. 


(27) 
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By introducing a new variable 7 * defined as 

1 , . . „ v 2 . 

7 i = — ( sin Ki + sin t) i+ i 1 = — sin /q, 
Pi Pi 

we obtain the following condition 

7i = 7i-! i = l,2,...,n 


from (1251) . This condition, along with ([25]) , gives rise to 


sin Kib sin /q_ 
Pib Pi—l,b 




which in turn yields the equilibrium values of K t b as 


( 7 t /2 Vz e { 1 , 2 ,..., ri}, or 

| — 7 t /2 V* £ { 1 , 2 , , n}. 


Now setting the dynamics of Ki to zero, we obtain 


(28) 


(29) 


(30) 


(31) 




(1 — A) sin(/Cj — Q!j) + Asin(ftjb — a 0 ) 

= — (sin/q + sin6» i+ i) = 7* 

Pi 


(32) 


for i = 1 , 2 ,..., n. As k^ = +n/2 and 9 i+1 = tt — Ki at a relative equilibrium, (152]) yields an 
equilibrium value for p. t given by 


2 sin Kib sin Ki 

p (j — l) sin k^ sin(/Cj — cy) + p cos «o 

Similarly, by (125]) an equilibrium value of p t b can be expressed as 

1 sin k^ 

^ lb p (j — l) sin k^ sin(/q — cp) + p cos ckq 7 i 


(33) 


(34) 


As we have shown earlier in (122]) that 7 \ = 7 for every i e { 1 , 2 ,... , n}, it follows from 
(155]) that the agents will be equi-distant from the beacon at any relative equilibrium. Hence, 
all relative equilibria for the system must be circling equilibria. Moreover, as both 
Pi and pib are required to be positive, we have necessary conditions for existence of circling 
equilibrium, given by 

A cos a 0 + (1 — A) sin /q 6 sin(/q — cq) > 0 (35) 

and, sin /q& sin Ki > 0. (36) 


4.1 Evaluating solutions for 

It is easy to check that at any (circling) equilibrium of the closed loop shape dynamics, (122]) 
with (152]) implies that 

sin(/q+i - CKj+i) = sin(/q - cp), (37) 
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Figure 2: Graphic representation of all possible solutions for sin(«j + i — «*+1) = sin( k* — cq), 
i = 1,2 ,,n wherein a* = n — a*, ft is important to note here that a particular branch of 
this tree might not yield a plausible value of Ki (due to closure and positivity constraints). 
The leftmost branch in this tree represents the relative equilibrium with equal (ft* — cq) for 
every agent. 


for which we have two possible solutions given by 


_ ( Ki- oti (38a) 

! j 7T - (Ki - cq) (38b) 

where i e {1,2,..., n}. Equilibrium values for Ki can therefore be derived from (|38a])-(j38bj, 
along with shape variable constraints (ITBlhflTTl) and positivity conditions (155j) - (15(l . 

If we let a* be the angle satisfying K\ — on = a* at equilibrium, then by (I38al) - (138bl) 
hi 2 — ol 2 must assume either a* or n — a*. This aspect of binary possibilities holds true for 
every agent and therefore results in the branching depicted in Fig [2] This figure provides 
a graphical illustration of all possible solutions for (l37]h with each branch representing a 
candidate solution for Kj. By considering a particular branch of the tree with M (where 
M e {1, 2, ■ ■ ■ , n}) copies of a* and (n — M ) copies of it — a*, we have 


n 

Yj = ( n 

i=1 


n 

M)tt + {2M~n)a* + J]cq. 

2 = 1 


(39) 


Now we focus on the shape variable constraints (flU - lTTj) to obtain solutions for a*. It 
is easy to check that the consistency conditions (1171) hold true at any relative equilibrium of 
the closed loop dynamics. Additionally, by exploiting the relationship between equilibrium 
values of Ki and the cycle closure constraint (fT6l) can be expressed as 

n 

= wtt, me Z, (40) 

2 = 1 

where Z is the set of integers. By substituting (1401) into (139|) . we have 

n 

(2 M — n)a* = [m + M — n )tt — ^ cq. 

2 = 1 
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We summarize the preceding discussion in the following proposition. 


Proposition 4.1. Consider an n-agent cyclic CB pursuit system with beacon, whose shape 
dynamics is governed by (1251) parametrized by p, X, and the CB parameters {a 0! a i , «2 5 • • •, a„}. 
The following statements are true. 


(a) The only possible relative equilibria are circling equilibria. 


(b) Whenever sin(2 af) A 0, a circling equilibrium exists if and only if there exists me Z 
and a = (di, cr 2 , ■ ■ ■, cr n ) e {—1, l} n such that 

(i) the cardinality M of the subset {di\di = 1, i = 1,2,... ,n} satisfies 

2M — n # 0, (42) 


and 

(ii) 

A cos «o + (1 — A) sin a* > 0, 

sin (a* + CTjOj) >0, i = 1 , 2, ..., n 

where a* is given by 


a 


* 


/ m + M — n\ ST ( \ 

V 2 M-n ) 7T ~ ti \2M -n) ' 


(43) 


(44) 


At equilibrium, we have either Kib = tt/ 2, i = 1,2,... ,n or km = —tt/2, i = 1,2,... ,n 
and the equilibrium values of K ir p ib , and p t given by 


he* 


7r(l - (Ji) 


+ + OLi) 


Ct* + OLi, 

7r — Ct* + CKj, 


Pib 


1 

pX cos oq + p (1 — A) sin K t b sin a* 


Pi = 2p ih sin K ih sin Ki. 


if cn = +1 

if di = -1 


Proof. The first statement of the proposition directly follows from (1341) . 

The preceding discussion has demonstrated that if a circling equilibrium exists, then K t b 
and Ki must satisfy (j3T]) . (l35]) - (l36l) . (]38al) - (]38bj) . and (140]) . and the equilibrium values for 6i, 
Pi and p^ can be expressed in terms of k^ and Ki by (127]) . (133]) . and (1541) . Further analysis 
of (1551) - (1551) demonstrated that if we let a* denotes the angle difference (ki — aq), then for 
each i, we have one of two possibilities - either Ki = a* + a* or Ki = n — a* + cq, which we 
represent by the binary tree in Fig[2j 

We now consider a particular branch of the binary tree (Fig [2]), for which Ki = a* + cq for 
exactly M agents (1 ^ M ^ n) and k* = 7 r —a* + cq for the remaining n — M agents. Clearly, 
for the first set of M agents we have sin k^ = sin(a* + af), while the remaining agents will 
have sin K t = sin(o(* — af), and therefore there exists some d = (cq, d 2 , ■ ■ ■ ,d n ) e { —1, l} 11 
such that sin Ki = sin(a* + crjcq) for every i = 1,2 ,...,n, and the cardinality of the set 
{di\di = 1 ,i = 1,2,... ,n) is AI. This implies that (I4T1) will hold (as demonstrated in the 
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previous discussion), and thus for n#, = tt/2, it is clear that the positivity conditions (I35l) - (l36l) 
can be expressed as (1551) . with (1441) following from (PUT) as long as 2M — n ^ 0. 

ft remains to be shown that (1551) also encompasses the case = — tt/2, so that (155]) is 
equivalent to (I55j) - (I551) . For n ib = —7r/2, the positivity conditions (I55j) - (I551) simplify to 

A cos Oo — (1 — A) sin a* > 0 

• / * \ n (45) 

sin(a + (JiOii) < 0, 


and we must show that there exists me Z such that (155j) with m substituted into (1551) 
is equivalent to (155j) . Choosing rh = m + 2 M — n yields the desired result, and therefore 
statement (b) of the proposition is established. The characterization of the associated equi¬ 
librium values follows from the preceding discussion, and also establishes the sufficiency of 
our existence conditions, completing the proof. □ 

Remark 4.2. The possibility of having 2 M — n = 0 cannot be ruled out for an even number 
of agents, in which case en can only be satisfied if^fai is an integer multiple of n. This 
case corresponds to existence of a continuum of circling equilibria. 


Remark 4.3. Letting Vy?;+i denote the angular separation between agent i and i + 1 at a 
circling equilibrium, we have 


cos^ i)i+ i 


pj b + pi + i,b - p! 

2 PibPi+l,b 


COs(2 Ki). 


(46) 


Therefore the equilibrium value of angular separation between agent i and agent i + 1 is 2fq. 


Remark 4.4. If we consider the special case for which (I38ap holds true for each pair of 
agents (i.e. the leftmost branch in Fig \f$), then we have a = (1,1,..., 1), i.e. M = n. In 
this case en simplifies to the form 


a 


* 



(47) 


5 Stability analysis for the two-agent system 


Here we consider the case where n = 2 and analyze the stability of the associated circling 
equilibria. For the two-agent system, our constraints (H6]) - (H71) imply that Pi = P 2 — P and 
Qi = Ki for i = 1, 2. Thus the dynamics (123|) simplify for the two-agent case to 


P 

ki 


— (cos Ki + COS ft 2 ) 
-p 


A 


(1 — A) sin(/-q — cq) + Asiffiz-qf, — ct 0 ) I —(sintci -1- sin^) 

J P 


Pib COS htib 

1 / , 1 

Kib = Ki -(sin K\ + sin k 2 ) H-sin n ibl i = 1,2, 

P Pib 


and are subject to the constraint (155|) which simplifies to 


(48) 


pl 2 - PlbR(K,b - fCi) - P2!.7?(«26 - K 2 ) = 0. 


(49) 
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5.1 Existence of circling equilibria for the two-agent case 


For the two-agent system, we have only two possible branches in Fig [2l The right-hand 
branch corresponds to M = 1, for which we have 2 M — n = 0, and Proposition \4-l does not 


apply. However, if aq + a 2 = kn for some HZ, then a continuum of equilibria exist with 
K\ and n 2 satisfying «q + k 2 = n + aq + a 2 . 

For the left-hand branch in FigEJ we have M = 2 (i.e. 2 M — n A 0) and therefore we 
can apply Proposition 4-1 (as long as sinQ]a!j) A 0) for which ilTTIi simplifies to 


a = m 


^)-m 


i =1 


(50) 


Thus we have (for i = 1,2) 


sin(o;* + cTjCtj) 


sin 


( 7r 

m —I- a 

V 2 


i 


OL 1 + tt 2 ^ 

2 / ’ 


(51) 


and the second constraint in (1431) requires m = +1. We label these options as Type 1 
and Type 2 two-agent circling equilibrium and summarize the resulting characterization in 
Table [T] where we have made use of the notation 


a + = (aq + a 2 )/2, a = (aq — cx 2 )/2. 


(52) 


5.2 Stability analysis 

We analyze the stability of two-agent circling equilibria by linearizing the dynamics (jlSj) 
about the equilibria described in the previous section. Following the line of thought from 
the stability analysis in p], we first demonstrate that the linearized dynamics will always 
have exactly one pair of pure imaginary eigenvalues resulting from the constraint equation 

m- 

First, denoting £ = {«i, /t 2 , p, «q b , k 2& , p u , p 2b } and the corresponding dynamics (jH|) by 
/(£), we express (fXfJ]) in terms of scalar constraints by 


0i (0 - p- Pib cos(K lb - Kq) - p 2 b cos(n 2b - « 2 ) = 0, 

02(0 - Pib sin(/ci6 - «q) + p 26 sin(re 26 - k 2 ) = 0. 

We define the manifold on which these constraints are satisfied by 

M = {f6M 7 ":<fc(O=0 2 (O = 0}, (53) 

which can be shown to be invariant under the dynamics (I48[) . If we let £ denote a repre¬ 
sentative circling equilibrium for the two-agent case and let £ = A£ denote the linearization 
of the dynamics (H9D about £, then it was demonstrated in [3] that invariance of M implies 
existence of a change of basis which will transform A into upper-triangular form with a 2 x 2 
lower-right hand block. A suitable explicit form for the change of basis is given by <f> = <&(£), 
where 


01 — Kl, £» 2 — « 2 , 03 — p, 04 — K\ ft, 

05 = Pib, 06 = 0l(£), 07 = 02 (0- 


(54) 
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We note that the corresponding equilibrium <f> = <!>(£) will have 0’s for the last two compo¬ 
nents. 

By a straightforward calculation, we have 


0i(O 

92(0 


sin Ki + sin k 2 ... 

—/(0 =- 7 - 02 ( 0 > 

002 (0 




p 

sin + sin « 2 ... 

/(0 = - 0 i 

P 


( 55 ) 


from whence it follows that, under the change of basis, the dynamics linearized about </> take 
the upper-triangular form 

(f) = A 11 * 

02x5 ^22 



with 


A22 — 


0 

sin ki + sin k ,2 
P 

0 +h ' 
+<5 0 


sin /^i+sin K2 


P 

0 




( 57 ) 


where 6 — /n(cosa 0 + (^7^) coscC). It is clear from (13711 that A 2 2 has a pair of pure 
imaginary eigenvalues at A = +jfiS (resulting from the constraint equation (14911 ). By analogy 
with the argument presented in [3], we focus our stability characterization on the remaining 
five eigenvalues. 

Returning to the original coordinates £, we proceed with our stability analysis by lin¬ 
earizing the dynamics about the Type 1 CCW circling equilibrium from Table [D One can 
show that the corresponding characteristic polynomial P(x) is given by 

P(x) = (x 2 + <f 2 )(x 2 + ATx + A5 2 )(x 3 + ATx 2 + 5 2 x + (1 — A)/isin a + 5 2 ), (58) 


where 


As expected based on the previous discussion, P(x) has two pure imaginary roots at x = +jS. 
It is also clear that the roots of the quadratic term will have strictly negative real part if and 
only if T > 0. By the Routh-Hurwitz criterion, the roots of the cubic factor will be in the 
open left-half plane if and only if T > 0, sin a + > 0, and ATh 2 — (1 — A)p sin a + S 2 > 0. Since 
this last condition simplifies to AT — (1 — A)/rsina + > 0, which always holds if sin(ao) > 0, 
our requirement for stability is given by sina + > 0 and sin(a 0 ) > 0. 

A similar analysis of the other possible circling equilibria (i.e. Type 1 CW and Type 2 
CCW and CW) results in analogous stability conditions, which can be summarized in the 
following proposition. 

Proposition 5.1. The Jacobian associated with the two-agent circling equilibria has two pure 
imaginary eigenvalues resulting from the constraint equation m- The remaining eigenvalues 
all have real parts less than zero if and only if 



T = p 


sin(ao) + 


A 


sm a 
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Type 1 

Type 2 

Existence Condition 

cos a - > 0 

A cos ao + (1 — A) cos a + > 0 

cos or < 0 

Acosao - (1 - A) cosa + > 0 


ccw cw cw ccw 


Chracterization 

of 

Equilibria 


Stability Condition 


Kib = 2 

= | + or 
K 2 = \ — or 
ipi 2 = vr + 2 a 


Kib = “2 
Ail = — + OL 

K2 = — f — a~ 
nj}i2 = —7r + 2a 


Kib = -f 
= | + a~ 
a '2 = ^ — a~ 
V^i 2 = 7r + 2 a 


= 2 

^ + a 

«2 = -f — 

■012 = — tt + 2 a' 


2A cos a 


ft = 


juAcosa 0 + /x(l — A) cos a 


^ i6 /iA cos a 0 + /;-(! - A) cos a + 

sinao > 0 sinao < 0 

sina + > 0 sina + < 0 


2Acosa 

^ n{\ — A) cos a + — fiX cos ao 

A 

_ lb /i(l — A) cosa + — ^Acosap 

sinao > 0 sinao < 0 

sina + <0 sina + > 0 


Table 1: Characterization of circling equilibria for a two-agent system (whenever sin(2a + ) ^ 
0), with a + — (oq + o^ 2)/2 and a~ — (a± — ot 2 )/ 2 . 

• sin(oio) > 0 and sinct + > 0 in the Type 1 CCW case; 

• sin(a 0 ) < 0 and sinaC < 0 in the Type 1 CW case; 

• sin(a 0 ) > 0 and sina + < 0 in the Type 2 CCW case; 

• sin(ao) < 0 and sina; + > 0 in the Type 2 CW case. 


Proof. Follows from the discussion above. □ 

Note that these results are also summarized in Table [1] 


6 Implementation Results 

6.1 Experimental setup 

We use Pioneer 3 DX (from Adept MobileRobots), a compact differential-drive mobile robot 
with reversible DC motors, high-resolution motion encoders, as the experimental platform. 
Onboard computation is done via 32-bit Renesas SH2-7144 RISC microprocessor, includ¬ 
ing the P3-SH microcontroller with ARCOS. ARIA, a software library from the developer, 
provides an interface for controlling and receiving data from the robot, and communication 
with the robot for sending control commands (forward velocity and turning rate) is carried 
out via 802.11-b/g/n networking. 

Algorithm implementation (i.e, feedback law computation) has been carried out in C++ 
using ROS (Robot Operating System), along with ROS-ARIA, as the interfacing robotics 
middleware. The experiments have been carried out in a laboratory environment equipped 
with a sub-millimeter accurate Vicon motion capture system ( www.vicon.com ). The Dell 
workstation, which we use to evaluate control commands at 25 Hz, is connected to the Vicon 
server via a dedicated Ethernet connection. 
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Figure 3: Mobile robot based experimental platform (Pioneer 3 DX) with two-wheel differ¬ 
ential and caster. 


6.2 Two robots with asymmetric distribution on the circle 

The first experiment presented here involves two robots circling around the beacon in a 
counter-clockwise direction. The parameters cq and cq were selected as 57r/12 and — 7t/12, 
respectively. These choices, by yielding the equilibrium value of angular separation as tt/2, 
demonstrate that the proposed approach can give rise to asymmetric distribution of agents 
on the circle (at equilibrium). Moreover, the parameter values ct 0 = tt/ 3 and A = 1/2 yield 
the circling radius as 

1 

^ lb /i( cos(7r/3) + cos(-7t/6)) ’ 

and by choosing p = 0.75m -1 we get pa, = 0.9761m. The corresponding robot trajectories 
are shown in Fig Ha] and the evolution of distance and angular separation for the agents 
are shown in Fig 0b] and Fig 00 respectively (refer [10] for implementation videos). These 
figures show a quick convergence to the circling equilibrium (within 150sec.). 

6.3 Five robots with symmetric distribution on the circle 

Next we choose control parameters which result in five robots circling around the beacon 
in a clockwise direction, with the robots distributed symmetrically around the circle. More 
specifically, we choose the same value for every cq (= —7 t/4 ), and let «o = —7 t/6 and A = 1/2. 
Then we have 

1 

^ lb /x(cos(—7r/6) — sin(—7r/5 + 7r/4)) ’ 

and a choice of p = 1.50m -1 yields an equilibrium circle radius of p^ = 0.9395m. The 
corresponding robot trajectories, along with the evolution of distance and angular separation 
of the agents, are shown in Fig [5] (refer [T3] for implementation videos). In this experiment 
we introduced a perturbation to the system at 723sec. into the experiment, and later (at 
868sec.) the beacon has been moved to a new position. In both cases, the formation quickly 
converges back to the desired circling equilibrium. 

6.4 Discussion 

The results show some level of imperfection during implementation of the proposed feedback 
law. This deviation from theoretical predictions can be attributed to multiple factors. To 
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(a) Robot trajectories 



(b) Distances from the beacon 



(c) Inter-agent angular separations 


Figure 4: Robot trajectories during implementation of f)23]) . along with evolution of relevant 
quantities (Note that, n = 2, a 0 = 7r/3, ou = 57t/12, 0:2 = —7r/12, A = 1/2, /r = 0.75?n -1 ). 


start with, our theoretical analysis assumes the agents to be point particles where in reality 
they occupy significant space (width - 380mm, swing radius - 260??r.m.). Also the placement 
of markers (necessary for measurement using Vicon motion capture system) introduces some 
error due to misalignment between center of the robot axle and origin of the body fixed 
frame. Furthermore, as only planar components of positions and heading were considered 
in measuring relevant quantities, a small slope (which has later been verified) in the lab 
floor acts as another source of error. However, in spite of these multiple sources of error, 
the proposed feedback mechanism (1221) is able to restrict the error margins well below the 
physical dimension of the agents. 

7 Conclusion and Future Work 

We have introduced a modified version of the CB pursuit law which references a fixed beacon 
as well as a neighboring agent, and demonstrated that implementation in a cycle graph (with 
“spokes”) yields an interesting set of closed-loop dynamics. Analysis of those dynamics 
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reveals the existence of circling equilibria centered on the beacon, and it is of particular 
interest that a specific equilibrium radius emerges as a function of the control parameters. 
Future work will focus on extending our analysis to the 3-d setting, as well as consideration 
of scenarios with multiple beacons or slowly moving beacons. 
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(a) Robot trajectories 



(b) Distances from the beacon 



(c) Inter-agent angular separations 


Figure 5: Robot trajectories during implementation of (l23j) . along with evolution of relevant 
quantities (Note that, n = 5, «o = — tt/6, at = — 7t/4, A = 1/2, p, = 1.50m _1 ). A perturbation 
was applied to the system at 723sec. into the experiment, and at 868sec. the beacon was 
relocated to a new position. 
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